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A  control  algorithm  for  the  automatic  steering  of  an  imaging  sensor  has  been 
developed.  Both  the  tracking  of  a  fixed  ground  point  and  the  stabilization  of  the 
sensor  are  addressed.  This  system  has  been  implemented  in  large  part  with  pre¬ 
existing  hardware  and  software  in  a  UAV  system.  This  report  describes  the  theoretical 
basis  of  the  system  as  well  as  detailing  the  issues  concerning  the  development  of  a 
working  prototype. 


V 


CONTENTS 


Nomenclature  vi 

Introduction  1 

Background  3 

Ground  Control  Station  .  3 

Air  Vehicle .  3 

Command  and  Control  System  .  4 

Sensor  Package .  4 

Data  Links .  4 

Algorithm  5 

Geometry .  5 

Spotting .  6 

Tracking .  8 

Implementation  10 

Speed  Considerations .  10 

Accuracy  Considerations .  11 

Numerical  Format  .  11 

Alignment .  11 

Sensor  Errors .  12 

Noise .  12 

Testing  14 

Bench  Tests .  14 

,  Flight  Tests .  14 

Test  Conclusions .  14 

Future  Work  16 

Improvement  of  Pointing  Accuracy .  16 

Heading  Error .  16 


11 


UNCLASSIFIED 


Altitude  Error . 16 

Air  Vehicle  Position  and  Attitude  Error .  17 

Improved  Camera  Mount .  18 

Pegasus  IB  Autopilot .  18 

New  Algorithm .  18 

Summary  20 

Appendix  A  A-1 


111 


LIST  OF  FIGURES 


1  Surveillance  UAV  System .  22 

2  Aircraft  Coordinate  Notation  .  23 

3  Sensor  Geometry .  24 

4  Overall  Geometry .  25 

5  Spotting  Process  .  26 

6  Tracking  Process .  27 


IV 


Symbol  Description 


C 

R 

G,  G 

P 


O 

X,  Y,  Z 
£/,  F,  W 
V,T 

L 


0,  « 
a  ...  i 
A  ...  F 
T 
P 


the  sensor’s  optical  axis 
a  scalar  multiple  of  C 
the  tracked  ground  point 
the  air  vehicle  location 

the  launch  site,  center  of  the  ground  frame  of  reference  (FoR) 

coordinate  axes  of  the  ground  FoR 

coordinates  axes  of  the  AV’s  FoR 

the  pan  and  tilt  angles  of  the  sensor  mount 

rotation  matrix,  ground  FoR  =>  AV  FoR 

rotation  matrix,  AV  FoR  ground  FoR 

the  AV’a  roll,  pitch  and  yaw  angles  respectively 

temporary  variables 

temporary  variables 

control  law  update  period 

filter  constant 

effective  filter  time  constant 


1 


1 


INTRODUCTION 


The  Unmanned  Vehicle  Systems  Group  (UVSG)  at  the  Defence  Research  Es¬ 
tablishment  SufHeld  conducts  research  in  the  area  of  unmanned  air  vehicles  (UAVs). 
Within  the  overall  area  of  UAV’s  the  primary  research  area  of  interest  to  UVSG  is 
command  and  control,  both  with  respect  to  the  airborne  command  and  control  sys¬ 
tem  (ACCS)  and  the  ground  control  station  (GCS)  components  of  sm  overall  UAV 
system. 

Since  1985  UVSG  has  participated  in  a  number  of  Canadian  Forces  exercises  by 
fielding  a  surveillance  UAV  system,  acting  both  as  a  collector  of  battlefield  intelligence 
and  as  a  forward  spotter  for  artillery  fire  correction  [1,  2].  The  experience  gained  has 
helped  in  defining  these  issues  which  most  critically  affect  the  ability  of  such  a  system 
to  collect  real-time  battlefield  information. 

One  such  issue  is  that  of  sensor  pointing  control.  The  sensor  package  used  to 
date  comprises  of  a  daylight  television  camera  and  steerable  mount.  Until  1987,  the 
control  of  this  sensor  package  was  purely  manual,  with  both  the  pan  and  tilt  angles 
of  the  mount  being  proportional  to  the  position  of  a  joystick  manned  by  the  payload 
operator  (one  of  three  GCS  personnel,  acting  also  as  image  analyst).  Great  difficulty 
was  experienced  by  the  payload  operator  due  to  a  lack  of  sensor  stabilization;  much  of 
his  concentration  was  required  to  compensate  for  small  random  air  vehicle  movements 
while  attempting  to  identify  a  target.  A  related  problem  was  the  disorientation  of 
the  payload  operator  after  the  air  vehicle  had  executed  a  sharp  manoeuvre.  It  was 
found  that  the  sensor  mount  was  incapable  of  turning  at  rates  required  to  keep  the 
target  in  the  field  of  view. 

While  the  problems  mentioned  above  could  be  reduced  by  using  a  dedicated 
stabilization  system  as  is  currently  employed  on  some  existing  UAV’s  [3]  these  have 
proven  to  be  heavy  and  complex.  This  report  will  deal  with  the  development  of 
an  alternative  distributed  stabilization  system,  that  is  one  which  employs  existing 
sensors  and  computing  resources  aboard  the  UAV.  This  is  the  first  step  in  a  process 
of  achieving  integrated  sensor  management. 

The  function  of  the  resulting  system  will  be  to  compensate  for  all  air  vehicle 
motions,  both  translational  (altitude,  northings  and  eastings)  and  rotational  (pitch, 
roll  and  yaw);  as  such  the  system  will  track  a  fixed  ground  point  as  well  as  pro- 


vide  some  degree  of  image  stabilization.  This  will  allow  the  payload  operator  to 
concentrate  fully  on  the  interpretation  of  the  image  once  he  has  selected  an  area  to 
examine,  regardless  of  the  air  vehicle’s  flight  path  or  manoeuvring.  (For  brevity  the 
term  “tracking”  will  be  synonymous  with  compensation  for  both  the  rotational  and 
translational  motions  of  the  air  vehicle;  “stabilization”  vnll  represent  compensation 
for  air  vehicle  rotations  only). 

The  sensor  mount  utilized  for  this  work  has  only  two  degrees  of  freedom  (pan 
and  tilt);  hence  it  cannot  provide  compensation  for  image  rotation. 


The  following  is  a  brief  description  of  the  UAV  system  in  use  during  the  de¬ 
velopment  of  the  control  system,  with  emphasis  placed  on  those  components  which 
are  directly  related  to  sensor  steering  (Fig.  1). 

Ground  Control  Station 

The  GCS  is  comprised  of  three  manned  workstations,  one  each  for  the  air 
vehicle  operator,  the  mission  planner  and  the  payload  operator. 

The  payload  operator  controls  the  pan  and  tilt  angles  of  the  sensor  through  a 
joystick,  either  directly  or  by  control  of  the  slew  rates.  The  zoom  of  the  sensor  lens 
can  be  set  to  one  of  eight  settings  through  menu  (keystroke)  commands,  the  resulting 
field  of  view  varying  from  4,5®  to  20®.  The  tracking  system  is  activated  or  deactivated 
by  menu  command  as  well. 

At  present  both  the  air  vehicle  and  payload  operators  have  some  control  over 
the  location  of  the  sensor  footprint.  This  leads  to  control  conflicts  unless  the  actions 
of  both  operators  are  somehow  coordinated.  Curently,  this  coordination  is  achieved 
verbally.  Future  configurations  will  implement  a  form  of  automatic  coordination  be¬ 
tween  the  air  vehicle  path  and  sensor  steering.  Footprint-guided  flight  and  automatic 
footprint  sweeping  are  examples  of  algorithms  which  manifest  this  automatic  coordi¬ 
nation. 


Air  Vehicle 

A  manned  surrogate  aircraft  is  currently  used  as  a  convenient  alternative  to  an 
actual  UAV  airframe.  While  having  different  turning  rates  and  speed  characteristics, 
the  surrogate  acts  as  a  good  platform  for  the  testing  of  avionics  and  control  system 
hardware  and  software. 
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Command  and  Control  System 

The  Pegasus  autopilot  [4]  is  bas(  ’  on  an  8  bit  microcomputer  operating  at  1.2 
MHz;  this  is  the  only  computing  element  present.  It  handles  all  of  the  computing 
tasks  required  by  the  UAV,  such  as  AV  stabilization  in  pitch  and  roll,  telemetry 
encoding/decoding,  sensor  steering,  engine  control  and  navigation.  All  of  the  control 
laws  are  updated  at  30  Hz. 

The  primary  sensors  to  the  autopilot  include  a  vertical  gyro,  a  three-axis  mag¬ 
netometer,  static  and  dynamic  pressure  transducers. 

Sensor  Package 

The  sensor  package  consists  of  a  shuttered  B&W  video  camera  with  zoom 
lens  attached  to  a  mount  having  two  degrees  of  freedom  (Table  I).  As  mentioned 
earlier,  its  maximum  pan  and  tilt  rates  are  not  sufBcient  to  maintain  track  while  the 
AV  is  executing  a  sharp  manoeuvre.  In  addition,  the  stringent  rate  and  acceleration 
requirements  for  stabilization  necessitated  the  design  of  an  improved  mount,  to  be 
described  later  in  this  report. 


Travel 

Rate 

Pan 

350® 

15  deg/sec 

Tilt 

100° 

15  deg/sec 

Table  1:  Mount  Performance 


Data  Links 

The  uplink  and  downlink  are  both  9600  baud  data  streams  consisting  of  12  bit 
data  words;  the  uplink  is  composed  of  a  16  word  frame  repeating  at  37.5  Hz,  while 
the  downlink  is  composed  of  a  variable-size  frame  which  allows  for  selectable  update 
rates  ranging  from  30  Hz  to  0.5  Hz. 

The  position  of  the  UAV  is  derived  in  the  GCS  from  a  complementary  filter 
[5]  which  combines  range  and  azimuth  data  from  a  tracking  radar  with  speed  and 
heading  data  from  the  UAV.  An  accurate  estimate  of  the  UAV’s  position  is  critical 
for  accurate  tracking  as  well  as  for  targeting  in  general;  this  method  provides  data 
which  is  more  precise  than  that  which  could  be  achieved  by  one  method  alone. 


The  tracking  of  a  fixed  point  on  the  ground  comprises  of  two  processes:  the  co¬ 
ordinates  of  the  point  must  be  initially  determined  (hereon  referred  to  as  ^spotting’’) 
and  the  camera’s  tilt  and  pan  angles  must  be  continually  updated  to  keep  the  field  of 
view  centered  on  the  point  (referred  to  as  “tracking”).  The  following  is  a  derivation 
of  the  algorithms  which  allow  the  autopilot  to  execute  these  processes. 

Geometry 

Standard  conventions  [6]  are  used  for  the  aircraft’s  body  frame  and  rotation 
angles.  See  Fig.  2.  The  ground  frame  of  reference  is  centered  at  the  launch  site  O, 
with  the  X,  Y  and  Z  axes  pointing  North,  East  and  down  respectively  (Fig  4). 

The  vector  C  is  defined  as  being  a  unit  vector  in  the  direction  of  the  camera’s 
optical  axis.  Vector  R  is  simply  a  scalar  multiple  of  C  ;  its  length  is  the  distance 
between  the  air  vehicle’s  position  and  the  point  of  intersection  of  the  camera’s  opticeJ 
axis  with  the  ground. 

R  =  \r\c  (1) 

Vector  P  represents  the  air  vehicle’s  position  in  the  ground  frame  of  reference, 
while  G  is  simply 

G=P+R  (2) 

The  ground  is  approximated  as  a  flat  plane  which  is  perpendicular  to  the 
Earth’s  local  gravity  vector.  Also,  the  camera’s  pan  and  tilt  angles  are  defined  as 
follows  (Fig.  3). 

•  pan  (P)  is  the  rotation  angle  of  C  about  W  measured  positive  from  U  to  V, 

•  tilt  (T)  is  the  angle  between  C  and  the  U  —  V  plane  mesisured  positive  from 
the  plane  to  the  negative  W  sixis, 
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•  the  direction  of  C  when  V  =  T  =  0  is  that  of  the  U  axis. 

Spotting 

A  rotation  matrix  L  [6]  can  be  used  to  convert  C  from  the  ground  frame  of 
reference  to  the  air  vehicle’s  (AV)  frame: 


(3) 


Gv 

■ 

Gx 

Gv 

L 

Gy 

Civ 

.  Cz  . 

where 


L  = 


cos  0  cos  ’I' 

sin  $  sin  0  cos  ’J’ 
—  cos  $  sin  9 

cos  $  sin  0  cos  9 
+  sin  $  sin  ^ 


cos  0  sin  ’5? 

sin  i  sin  0  sin  $ 
+  cos  $  cos  9 

cos  $  sin  0  sin  ® 
—  sin  $  cos  9 


-  sin  0 
sin  $  cos  0 

cos  $  cos  0 


(4) 


and  ($,  0,  ’i')  are  the  aircraft’s  roll,  pitch  and  yaw  angles  respectively. 

The  matrix  L  is  actually  the  product  of  three  rotation  matrices,  one  about 
each  body  axis: 


L  =  Li($)L2(©)L3(^) 


(5) 


Note  that  the  order  of  rotations  is  significant;  to  determine  the  orientation  of 
the  aircraft  which  corresponds  to  a  given  set  ($,  0,  9),  the  aircraft  is  first  yawed, 
then  pitched,  then  rolled,  each  time  about  the  aircraft’s  body  axes  and  not  the  ground 
frame’s  axes.  The  gyroscope  -  magnetometer  combination  provides  values  of  pitch, 
roll  and  yaw  which  correspond  to  this  ordering. 

To  find  G  we  must  first  solve  £q.  3  for  C  expressed  in  the  ground  frame. 


Gx 

■ 

Gv 

Gy 

= 

M 

Gv 

.  Cz  . 

Gw 

where  M  is  the  inverse  of  L.  Since  L  is  a  unitary  matrix,  its  inverse  is  simply 
its  transpose: 


M  = 


cos  0  cos  $ 

cos  0  sin  ^ 
-  sin  0 


sin  $  sin  0  cos 
—  cos  $  sin  9 

sin  $  sin  0  sin  $ 
+  cos  $  cos 

sin  $  cos  0 


cos  $  sin  0  cos  $ 
+  sin  $  sin  9 

cos  $  sin  0  sin  $ 
—  sin  §  cos 

cos  $  cos  0 


For  brevity,  the  entries  of  M  will  be  abbreviated  as  follows: 


M  = 


a  b  c 
d  e  f 
g  h  i 


(7) 


(8) 


The  vector  can  be  written  in  terms  of  the  pan  and  tilt  angles  (Fig.  3). 


Cu 

cos  T  cos  V  ' 

Cv 

cos  T  sin  V 

Cw 

-sinT 

(9) 


Substituting  Eq.  9  into  Eq.  6  results  in 


Cx 

a(cos  T  cos  V)  +  6(cos  T  sin  P)  +  c(—  sin  T) 

Cy 

= 

(/(cosT cosP)  +  c(co8T sinP)  +  /(-  sinT) 

^(cos  T  cos  V)  +  h(cos  T  sin  V)-\-i{—  sin  T) 

(10) 


From  Eq.  1  one  writes 


_  RzCx 
Cz 


(11) 


_  RzCy 


(12) 
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and  from  £q.  2 


Gx  =  Px  +  Px 

Gy  =  Py  +  Ry  (13) 

The  spotting  process  is  shown  in  Fig.  5.  When  evaluating  the  above  equations 
the  air  vehicle’s  northings  and  eastings  relative  to  the  launch  site  O  are  used  for  Px 
and  Py.  The  air  vehicle’s  altitude  is  substituted  for  Rz,  which  is  equal  to  Pz  due  to 
the  flat  earth  assumption. 

Tracking 

Eq.  11  can  be  expanded  as  follows: 

Rx  [^(cos  T cos  ■p)  +  h(cos T sin  V)  —  i  sin  T]  = 

Rz  [o(co8T  cosP)  +  fe(cosT  sinP)  —  csinT]  (14) 


This  can  be  rewritten  as 


tanT  = 


cos  V  [Rx9  —  Rzo]  +  sin  V  [/ix^  ~  Rzb] 
[iZxi  -  Rzc] 


(15) 


Likewise,  Eq.  12  can  be  rewritten  as 

cos  V  [Ryg  —  Rz^  +  sin  V  [fiy  h  —  Rze] 


tanT  = 


[Hyt  —  Rzf] 


(16) 


For  brevity,  Eq.  15  will  be  written  as 

A  cos  P  +  B  sin  P 


tanT  = 


(17) 


and  likewise  for  Eq.  16: 


tanT  = 


D  cos  V  +  E  s\nV 


(18) 


By  equating  Eq.  17  and  Eq.  18  we  can  write 


^  ^  (DC-AF\  ,  , 

^  \bf-ce) 

The  final  form  of  this  equation  has  been  written  with  only  one  division  to 
accommodate  a  rapid  calculation  by  the  autopilot.  Once  the  pan  angle  has  been 
calculated  by  the  above  equation,  the  tilt  angle  can  be  found  by  returning  to  either 
Eq.  17  or  Eq.  18. 

Solving  the  above  equations  results  in  two  possible  sets  of  {V,  T):  one  which 
corresponds  to  R,  the  other  which  corresponds  to  —R.  To  determine  the  correct 
choice,  the  component  of  R  along  the  W  axis  is  found. 

If  C  is  replaced  with  R  in  Eq.  3: 

Rw  —  Rxc  +  Ryf  +  Rzi  (20) 


The  decision  as  to  which  set  to  choose  is  made  as  follows: 

1 .  if  Rw  is  positive,  choose  the  set  with  a  negative  tilt  angle, 

2.  if  is  negative,  choose  the  set  with  a  positive  tilt  angle.  (As  a  positive  tilt 
angle  is  physically  impossible  for  the  camera  to  realize,  the  tilt  is  in  reality  set 
to  zero).  This  situation  may  conceivably  arise  if  the  target  point  is  far  from 
the  aircraft  and  the  aircraft  is  pitched  or  rolled  in  the  direction  of  the  target 
point.  The  pan  angle  is  nevertheless  set  correctly,  which  allows  for  a  quick 
reacquisition  once  the  target  becomes  “visible”  again. 

3.  if  Rw  is  close  to  zero,  the  choice  as  to  which  set  to  use  would  have  to  be  based 
on  some  other  criteria.  In  this  case  R  ot  ~R  is  chosen  according  to  P;  that 
vector  which  results  in  a  value  of  V  closest  to  the  value  computed  during  the 
last  update  cycle  is  chosen. 

Methods  (i)  and  (ii)  may  produce  incorrect  results  if  T  is  small  in  magnitude: 
Rw  will  also  be  small  in  this  case,  and  could  potentially  be  of  the  wrong  sign  due  to 
noise  or  to  the  time  lag  of  the  overall  system.  Conversely,  method  (iii)  may  produce 
incorrect  results  if  T  is  close  to  90®.  In  this  case  the  rate  of  change  of  V  csm  approach 
infinity  as  C  passes  near  this  point,  and  a  choice  based  on  the  smallest  change  of 
V  may  be  erroneous.  For  these  reasons  the  threshold  value  of  T  used  to  determine 
which  method  is  to  be  used  can  set  arbitrarily  to  some  value  which  is  close  to  neither 
0®  nor  90®. 

The  tracking  process  is  shown  in  Fig.  6. 


The  above  algorithms  for  spotting  and  tracking  have  been  used  in  the  writing 
of  two  sets  of  software;  one  includes  the  actual  assembler  code  which  is  meant  to 
be  integrated  into  the  existing  Pegasus  software,  along  with  test  versions  meant  for 
emulation  only.  The  other  includes  short  PASCAL  programs  which  aid  in  testing 
both  the  validity  of  the  algorithm  and  the  more  complex  assembler  code. 

The  remainder  of  this  report  describes  the  process  of  implementing  this  algo¬ 
rithm  into  our  existing  UAV  system. 

Speed  Considerations 

Due  to  the  limited  amount  of  processing  power  available  in  the  autopilot,  it 
was  necessary  to  update  the  tracking  routine  at  15Hz,  instead  of  30Hz  as  is  the  case 
with  the  remainder  of  the  functions  executed. 

The  computations  are  performed  in  the  large  part  with  a  24  bit  fixed  point 
numerical  format,  allowing  for  very  fast  addition,  subtraction  and  multiplication. 
In  addition  to  the  aforementioned,  the  only  other  operations  required  by  the  final 
equations  were  those  of  division  and  arctangent,  which  were  implemented  as  shown 
in  the  appendix.  A  listing  of  the  execution  times  required  by  each  operation  when 
run  on  the  Pegasus  autopilot  is  shown  in  Table  II. 


Operation 

Execution  Time 

add  /  subtract 

21.2  fiscc 

mTiltiply 

167.2  fisec 

divide 

1.26  msec 

arctan 

0.60  msec 

Table  II;  Execution  Times 
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Accuracy  Considerations 

The  original  performance  goal  was  to  achieve  pointing  accuracy  within  1°; 
while  not  overly  stringent,  this  nevertheless  required  attention  to  certain  error  sources 
as  listed  below. 

Numerical  Format 

As  mentioned  earlier,  the  computations  are  performed  in  a  24  bit  fixed  point 
format;  this  format  represents  a  fractional  value  which  varies  from  -1.0  to  -1-1.0. 
Multiplications  will  therefore  invariably  produce  results  which  have  an  accuracy  which 
is  less  than  or  equal  to  that  of  the  multiplicands.  To  offset  this  trend,  it  is  necessary 
to  shift  the  values,  which  is  done  only  at  certain  locations  in  the  software.  This  “semi 
floating  point”  operation  is  essentially  a  compromise  between  the  accuracy  of  floating 
point  and  the  speed  of  fixed  point  operations. 

A  related  problem  was  the  evaluation  of  Eq.  17  or  Eq.  18;  both  of  these 
will  approach  the  undefined  value  of  0/0  for  certain  aircraft  and  camera  orientations. 
These  equations  do  not  both  approach  the  singularity  simultaneously,  and  the  problem 
was  thus  solved  by  allowing  the  software  to  chose  the  appropriate  one  when  calculating 
T. 


Alignmgpt 

Proper  operation  of  the  tracking  system  depends  on  the  alignment  of  a  subset 
of  the  equipment  onboard  the  AV,  namely  the  magnetometer,  the  vertical  gyroscope 
and  the  camera  mount.  These  devices  can  be  thought  of  as  each  measuring  a  vector  in 
space  (the  local  geomagnetic  field,  gravity  and  C  respectively);  these  vectors  must  be 
measured  in  the  same  coordinate  frame.  If  this  cannot  be  easily  accomplished  through 
the  construction  of  the  mounting  hardware,  it  can  be  done  by  rotating  the  data  in 
the  autopilot  software.  This  method  is  used  in  the  case  of  the  magnetometer,  which 
is  mounted  in  the  tip  of  a  wing  with  a  significant  dihedral  and  sweep-back  angle.  The 
rotation  angles  needed  were  determined  with  precise  surveying  of  the  gyroscope  and 
magnetometer  sites. 

Note  that  the  problem  of  wing  flexure  during  flight  had  not  been  addressed. 
This  flexure  can  be  thought  of  as  having  two  components:  a  fixed  amount  observed 
during  steady,  level  flight,  and  a  variable  component  arising  due  to  manoeuvres  (both 
being  significant  when  using  a  surrogate  aircraft).  The  rotation  imparted  to  the 
magnetometer  by  the  fixed  component  can  in  principle  be  deduced  from  data  recorded 
during  flight.  In  practice  this  problem  may  not  occur  depending  on  the  location  of 
the  magnetometer  and  on  the  type  of  mreraft  used. 
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Sensor  Errors 

The  specified  performance  of  both  the  gyroscope  and  magnetometer  used  in¬ 
dicates  that  these  sensors  would  not  be  the  source  of  significant  tracking  errors. 

The  use  of  a  static  pressure  transducer  as  an  altimeter  was  originally  intended 
for  general  flight  control.  In  the  case  of  tracking,  the  multiple  inaccuracies  inherent 
in  this  form  of  altimeter,  some  of  which  are  listed  below,  can  produce  a  significant 
tracking  error: 

•  the  temperature  sensitivity  of  both  the  transducer  and  its  reference  voltage, 

•  local  pressure  changes  at  the  static  port  due  to  the  AV’s  aerodynamics, 

•  pressure  changes  due  to  changing  meteorological  conditions, 

•  differences  between  the  elevation  of  the  UAV’s  launching  point  (the  “flat  earth” 
reference  elevation)  and  that  of  G. 

Some  efforts  were  made  to  control  the  temperature  sensitivity  of  the  altimeter; 
other  altimeter  issues  are  discussed  in  the  remainder  of  this  report. 

The  positional  errors  inherent  to  the  camera  mount  can  be  controlled  during 
its  construction  if  attention  is  paid  to  the  alignment  of  the  pan  and  tilt  axes,  the 
alignment  of  the  camera  within  the  mount,  the  quality  of  the  readout  devices,  etc. 

Noise 

To  avoid  gross  errors  in  the  estimate  of  R  due  to  sporadic  noise,  an  average 
value  is  derived  from  multiple  spottings.  The  number  of  spottings  involves  a  trade-off 
between  the  noise-induced  error  and  the  error  due  to  camera  drift  during  the  spotting 
series. 

The  noise  present  on  all  of  the  many  input  signals  to  the  tracking  routine 
necessitated  the  inclusion  of  filtering.  First  order  pole  filters  (HR)  were  applied  to 
the  output  of  the  track  routine: 

KIn|  =  (l-;9)y|n-ll+0.Y|nl  (21) 


where  the  time  constant  r  is 


-T 

ln(l-;3) 


(22) 


Here  T  =  1/30  sec.  and  /?  =  1/8,  resulting  in  a  time  constant  of  0.25  sec. 
The  time  lag  introduced  by  the  large  value  of  r  is  obviously  a  limiting  factor  in  the 
tracking  system’s  bandwidth.  Reduction  of  the  noise  present  on  all  input  signals 
would  allow  for  a  reduction  in  the  amount  of  filtering  in  the  tracking  routine,  which 
in  turn  may  increase  the  responsiveness  of  the  overall  system,  depending  on  which 
component  has  the  dominant  time  constant;  filter,  mount  or  otherwise. 

An  analysis  of  the  sensitivity  of  the  complete  system  to  noise,  both  steady- 
state  and  time-varying,  will  not  be  presented  here;  suffice  it  to  say  the  sensitivity  is 
generally  a  non-linear  function  of  a  subset  of  the  input  values.  Some  of  the  more 
important  examples  are  listed  below. 

The  tracking  routine  is  most  sensitive  to  noise  in  the  following  cases: 

•  When  flying  near  G,  the  routine  is  sensitive  to  noise  in  all  components  of  the 
estimate  of  the  air  vehicle’s  position  (P). 

•  When  flying  directly  above  G  or  nearly  so,  the  routine  is  sensitive  to  noise  in 
the  estimation  of  the  AV’s  northings  and  eastings  {Px  and  /V)«  but  only  in 
the  calculation  of  V,  which  results  in  random  image  rotation.  Nevertheless,  the 
actual  tracking  accuracy  is  not  affected. 

The  spotting  routine  is  sensitive  to  noise  in  the  estimates  of  both  the  air 
vehicle’s  attitude  ($,  0,  ff)  and  sdtitude  {Pz)  when  either  Rx  or  Ry  are  large  in 
comparison  to  Rz. 
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TESTING 


Bench  Tests 

The  validity  of  the  algorithm  was  first  determined  with  simple  simulations  us¬ 
ing  the  PASCAL  version.  Here  attention  was  paid  to  agreement  between  the  spotting 
and  tracking  routines.  The  numeric^d  accuracy  of  the  assembly  language  version  was 
determined  by  comparing  its  results  with  that  of  the  PASCAL  version.  Finally,  the 
assembly  language  code  was  integrated  into  the  Pegasus  autopilot,  which  was  tested 
with  simulated  sensor  data. 

Flight  Tests 

The  operation  of  the  tracking  system  was  observed  to  be  essentially  correct 
during  a  series  of  flight  trials.  Nevertheless,  the  system  was  not  used  by  GCS  personnel 
during  Canadian  Forces  exercises  in  1988  and  89,  preferring  instead  the  manual  control 
mode.  The  specific  problems  which  were  noted  at  the  time  include: 

•  The  pointing  accuracy  was  not  sufficient  to  keep  G  in  the  field  of  view  (  4.5®  ) 
of  the  camera  when  high  magnification  was  used.  High  magnification  was  used 
by  the  payload  operator  when  attempting  to  identify  individual  targets. 

•  Serious  tracking  errors  would  occur  in  the  case  of  loss  of  air  vehicle  position 
data  due  to  errors  in  the  uplink  telemetry. 

•  Difficulty  was  experienced  by  the  payload  operator  when  attempting  to  relocate 
G  to  another  target.  Once  ageun  this  was  done  at  high  magnification,  whereby 
the  small  random  motions  of  the  air  vehicle  would  cause  large  motions  in  the 
FoV.  The  tracking  system  was  unable  to  compensate  for  these  motions  (with 
frequencies  above  2  Hz  and  amplitudes  greater  than  1°). 

Test  Conclusions 

The  performance  achieved  by  the  tracking  system  was  found  to  be  very  de¬ 
pendent  on  both  i)  the  quality  of  the  input  data  and  ii)  the  ability  of  the  sensor 
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mount  to  respond  quickly  to  positioning  commands.  Both  of  these  points  are  specific 
to  the  particular  implementation,  and  as  such  are  not  due  to  the  correctness  of  the 
algorithm,  nevertheless  they  must  be  addressed. 

In  addition,  it  may  be  possible  to  improve  the  usefulness  of  the  tracking  system 
by  modifying  the  algorithm  such  that  user- commanded  corrections  can  be  applied 
without  the  loss  of  stabilization. 

Methods  of  improving  i)  and  ii),  as  well  as  the  modified  tracking  algorithm 
are  discussed  in  the  following  chapter. 
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Improvement  of  Pointing  Accuracy 

The  final  pointing  accuracy  of  the  tracking  system  is  largely  based  on  the 
accuracy  of  each  input  data  stream.  This  section  discusses  the  nature  of  the  more 
important  errors  in  the  input  data,  along  with  potential  improvement  methods.  Accu¬ 
racy  improvements  are  also  inherent  in  the  use  of  the  modified  autopilot  and  camera 
mount,  described  later  in  this  chapter. 

Heading  Error 

The  calculation  of  the  AV’s  heading  is  very  sensitive  to  any  misalignment 
between  the  magnetometer  and  vertical  gyro.  This  is  due  to  the  fact  that  the  geo¬ 
magnetic  field  is  close  to  vertical  at  northern  latitudes,  and  that  heading  is  determined 
by  the  horizontal  component.  More  accurate  heading  estimates  could  be  achieved  by 
the  relocation  of  the  magnetometer  to  a  more  rigid  location  on  the  airframe,  as  well 
iis  by  fusing  with  rate  gyro  data.  As  an  extreme,  it  may  be  necessary  to  model  wing 
flexure  within  the  autopilot  smd  thereby  estimate  the  needed  rotation. 

Altitude  Error 

Errors  due  to  the  altimeter  are  potentially  significant.  These  errors  can  be 
separated  into  two  categories:  errors  due  to  the  flat  earth  assumption,  and  sensor 
errors. 

The  “flat  earth”  error  can  further  be  broken  into  an  error  due  to  the  Earth’s 
curvature,  and  an  error  due  to  local  terrain  elevation  changes  within  the  UAV’s  op¬ 
erating  radius.  A  barometric  altimeter  (which  provides  Pz)  does  not  have  an  error 
associated  with  the  Earth’s  curvature;  nevertheless  the  assumption  that  Pz  =  Rz 
is  no  longer  valid.  The  resulting  error  {Pz  —  Rz)  is  negligible  when  the  horizontal 
component  of  R  is  10  Km  or  less. 

Local  elevation  changes  are  typically  in  the  order  of  hundreds  of  meters  over 
the  area  covered  by  a  short-ranged  UA'^.  This  error  can  be  compensated  for  with  a 
digital  terrain  elevation  map,  stored  either  in  the  GCS  or  the  UAV.  As  an  alternative, 


an  active  altimeter  could  be  used,  such  as  a  radar  altimeter  or  laser  rangefinder.  In 
the  case  of  a  radar  altimeter  or  similar  sensor,  the  altitude  of  the  air  vehicle  over  the 
local  terrain  would  be  known  precisely,  yet  there  would  remain  an  unknown  difference 
between  the  elevation  of  G  and  that  of  the  terridn  directly  below  the  air  vehicle  (5). 
This  error  would  tend  to  increase  with  the  distance  G  —  S.  A  laser  rangefinder, 
mounted  collinearly  to  the  imaging  sensor,  would  provide  an  accurate  estimate  of 
each  component  of  R.  If  the  laser  rangefinder  was  the  only  source  of  altitude  data, 
it  would  be  necessary  to  assume  that  tracking  was  precise,  and  that  any  changes  in 
|a|  were  due  changes  in  the  AV’s  position.  This  could  lead  to  an  unstable  tracking 
system. 

If  it  is  assumed  that  the  barometric  altimeter  used  is  sufficiently  accurate, 
weather-related  changes  in  pressure  become  the  primary  sensor  error  for  long  duration 
flights.  As  with  the  magnetometer,  it  may  be  possible  to  improve  the  signal  with 
compensations,  such  as  with  barometric  data  measured  at  the  GCS. 

The  best  estimate  of  Rz  would  be  obtained  with  a  combination  of  sources, 
such  as  a  radar  altimeter  used  in  conjunction  with  a  terrain  elevation  map,  or  a  laser 
rangefinder  used  with  a  barometric  altimeter. 

Air  Vehicle  Position  and  Attitude  Error 

As  mentioned  earlier,  poor  quality  uplink  can  produce  tracking  errors,  in  this 
case  by  way  of  corrupted  ur  vehicle  position  data.  This  and  similar  uplink  problems 
can  be  reduced  with  the  use  of  an  onboard  model  of  the  AV  flight  dynamics  (essentially 
a  short  term  navigation  system).  The  AV  position  as  predicted  by  the  model  would 
be  used  in  the  case  that  there  is  a  large  disagreement  between  it  and  the  position 
data  arriving  on  the  uplink. 

Work  is  currently  underway  at  DRES  to  apply  a  differential  Global  Positioning 
System  (DGPS)  in  a  surveillance  UAV  [7].  Apart  from  benefits  such  as  increased 
AV  range  and  autonomy,  a  DGPS  system  could  provide  navigation  data  including 
altitude,  accurate  to  within  5  meters,  which  is  an  obvious  improvement  over  that 
available  from  tracking  radars  and  our  current  altimeter.  Work  is  also  underway  to 
integrate  a  strapdown  AHRS  system  into  the  avionics  suite  so  as  to  achieve  a  more 
precise  estimate  of  the  AV’s  attitude. 


Improved  Camera  Mount 

The  next  flights  will  incorporate  a  modified  camera  mount.  Its  main  improve¬ 
ments  over  the  previous  mount  are: 

•  much  improved  slew  rates  in  both  axes  (minimum  60  deg/sec). 


•  angular  accelerations  of  300  deg/sec*, 


•  continuous  360°  travel  in  pan, 

•  precise  construction  necessary  to  ensure  proper  alignment, 

•  accurate  position  encoders, 

•  the  potential  for  conversion  to  fully  digital  control. 

An  overall  betterment  in  the  tracking  accuracy  should  result,  as  well  as  im¬ 
proved  stabilization.  This  mount  is  in  the  prototype  stage  and  will  require  test  flights 
to  ascertain  its  full  usefulness. 

re.rzisus  IB  Autopilot 

A  modified  version  of  the  Pegasus  autopilot  is  currently  being  developed  to 
address  the  limitations  of  memory  and  computation  capabilities  which  were  encoun¬ 
tered  during  the  development  of  the  tracking  algorithir  These  modifications  result 
in: 

•  an  increase  in  clock  speed  from  1.22  to  1.852  MHz,  improving  computational 
speed  by  over  50  %, 

•  increased  RAM  (8  Kbytes)  and  EPROM  (64  Kbytes), 

•  an  improved  stable  reference  voltage  for  use  with  the  altimeter. 

New  Algorithm 

It  has  been  noted  that  the  payload  operator  experiences  difficulty  when  re¬ 
positioning  the  camera  from  one  ground  point  to  another,  mainly  due  to  the  lack  of 
any  stabilization  during  this  transitir  >  As  a  result  it  would  be  desirable  to  implement 
an  algorithm  which  provides  stab’”  -ion  continuously,  and  not  only  during  tracking 
mode  as  has  been  the  case.  A  j  t^osible  solution  is  outlined  below: 

1.  Upon  entry  into  the  stabilization  mode,  use  V,  T  and  ($,  0,  to  produce  a 
unit  vector  C  with  respect  to  the  ground  frame  of  reference. 

2.  Use  the  pan  command  to  modify  the  azimuth  of  C  in  the  ground  FoR;  likewise 
use  the  tilt  command  to  modify  the  elevation  of  C.  The  commanded  values 
will  be  derived  from  the  summation  of  two  weighed  components,  one  from  the 
joystick  and  the  other  from  the  tracking  algorithm  (if  selected). 
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3.  Use  the  newly  modified  C,  as  well  as  the  present  ($,  Q,  to  produce  the  pan 
and  tilt  positioning  commands  for  the  camera  mount. 

4.  Repeat  (ii)  through  (iv). 

This  method  involves  the  interpretation  of  joystick  commands  as  movements 
in  the  ground  FoR  instead  of  in  the  air  vehicle  FoR  as  before,  which  may  prove  more 
intuitive  to  the  payload  operator.  Secondly,  the  joystick  commands  can  be  thought 
of  as  corrections  to  the  location  of  G;  this  would  give  the  payload  operator  the  ability 
to  select  multiple  targets  in  quick  succession  while  retaining  the  benefits  of  tracking. 
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An  algorithm  has  been  developed  which  allows  for  the  automatic  tracking  of  a 
fixed  ground  point  using  our  existing  avionics  suite  and  video  camera  payload.  This 
algorithm  has  been  implemented  in  the  Pegsisus  autopilot  and  tested  during  several 
flights  aboard  a  surrogate  UAV.  While  the  basic  operation  of  the  tracking  mode  was 
observed  to  be  correct,  the  poor  precision  and  speed  of  the  system  resulted  in  limited 
usefulness.  These  problems  will  be  addressed  in  the  short  term  with  an  improved 
camera  mount  and  autopilot,  and  in  the  long  term  with  advanced  navigation  systems 
such  as  the  Global  Positioning  System. 
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ARCTAN  is  implemented  as  the  reverse  look-up  of  a  tangent  table;  a  direct 
look-up  of  an  arctangent  table  would  not  have  been  feasible  as  the  high  non¬ 
linearity  of  the  function  would  have  caused  a  loss  of  resolution  in  the  table  for 
small  angles. 

DIVX  is  implemented  as  two  16  bit  integer  divisions  which,  although  not  as 
precise  as  a  full  24  bit  division,  is  much  faster,  due  in  great  part  to  a  16  bit 
transfer  instruction  available  to  the  63701  microcomputer.  The  first  division  is 
quotient/di  visor,  which  produces  a  remainder,  the  second  is  remainder/di  visor. 

Some  further  clarification  is  required  to  explain  the  two  following  operations; 

-  The  24  bit  format  is  generally  used  to  represent  a  signed  fractional  value 
which  varies  from  -1.0  to  -1-1.0  -  6,  where  6  =  2~”. 

-  This  value  may  include  an  implied  exponent  which  is  some  power  of  2, 
depending  on  its  use  in  the  program. 

-  To  produce  an  output  which  is  precise  to  within  0.5°,  the  arctangent  func¬ 
tion  need  only  accept  arguments  with  a  magnitude  less  than  127;  argu¬ 
ments  with  implied  exponents  of  2”  are  thus  properly  formatted  for  this 
function,  being  that  they  will  have  the  greatest  possible  resolution  while 
encompassing  the  necessary  range. 

-  The  result  of  a  division  is  always  used  as  the  argument  for  an  arctangent, 
hence  its  result  should  have  an  implied  exponent  of  2*. 


* 


*  DIVX 

* 

*  THIS  PROGRAM  IS  A  DOUBLE  16-BIT  DI7IDE 

*  WHICH  PRODUCES  A  16-BIT  RESULT.  THIS  RESULT 

*  IS  BOTH  SHIFTED  RIGHT  8  TIMES  AID  LIMITED 

*  TO  A  VALUE  OF  7F  (127), 

* 

*  syntax  such  as  "  valua  ->  C  “  danotas  tha  contants  of  a  ragistar, 

*  while  "  (valua)  ->  C  "  also  io^lias  that  tha  contants  happen  to 

*  be  inconsequential  to  tha  program. 

* 


LIIEO 

BIE 

SKIPl 

is  tha  divisor  -  0  ? 

LDAA 

«OFFH 

STAA 

DIV.FLG 

yas,  sat  error  flag  and  return. 

RTS 

SKIPl 

CLR 

DIV.FLG 

no,  clear  tha  error  flag. 

CLR 

SIGH 

SIGI  records  tha  sign  of  tha  quotian 

TSTA 

is  tha  divisor  negative  ? 

BPL 

LIIEA 

If  so,  negate  both  the  divisor 

COMA 

and  the  sign  flag. 

COMB 

ADDD 

*1 

COM 

SI6I 

LIIEA 

STD 

DIVISOR 

LDD 

V_ACC 

BPL 

LIIEB 

is  the  dividend  negative  ? 

COMA 

if  so,  negate  both  the  dividend 

COMB 

and  the  sign  flag. 

ADDD 

«1 

COM 

SIGI 

LIIEB 

JSR 

B.ROLLS 

do  a  16  bit  divide.  V.ACC  /  DIVISOR. 

TSTA 

BPL 

LIIEB 

ADDD 

DIVISOR 

adjust  remainder  (step  2,  p.  267). 

*  this 

section 

limits  tha 

absolute  value  of  the  result  to  7F  (127); 

*  i.a.  a  quotient  greater  than  127  is  considered  to  be  approx.  127. 
LIIE6  IGDI  quot.  ->  D  ram.  ->  X 


A-3 


TSTA 

BEQ 

SKIP2 

are  8  m.s.  bits  of  quotient  >  0  ? 

TST 

SIGl 

no,  should  the  result  be  positive  ? 

BPL 

LIIEC 

LDD 

tSOOOH 

no,  set  V_ACC  to  -1. 

BRA 

LIIED 

LIIEC 

LDD 

#7FFFH 

yes,  set  V.ACC  to  *1. 

LIIED 

STD 

V.ACC 

CLR 

V_ACC+2 

RTS 

return  to  main  program. 

SKIP2 

STAB 

V.ACC 

yes;  store  the  8  l.s.  bits  of  the 

* 

quotient  into  V.ACC. 

^i^i^^it,^if^^t^<^itft04**************************************************** 


*  this  ssction  shifts  the  rsisaindsr  up  by  sithsr  8  or  4  or  not  at 

*  all,  whichsTsr  is  ths  highest  possible.  It  then  shifts  the 

*  divisor  accordingly  nntil  it  has  been  shifted  8  bits  dosn  s.r.t 

*  the  remainder. 


e****************************************************************** 


LIIE6 


ZGDZ 

BITA 

tOFOH 

BIE 

LIIE6 

ASLD 

ASLD 

ASLD 

ASLD 

BITA 

*0F0H 

BIE 

LIIE7 

ASLD 

ASLD 

ASLD 

ASLD 

JSR 

B.ROLLS 

BRA 

LIIE8 

X6DX 

LDD 

DIVISOR 

LSRD 

LSRO 

LSRD 

LSRD 

LSRD 

LSRD 

(quot).  ->  Z  rem.  ->  D 
can  the  remainder  be  shifted  up  by  4  ? 
no;  (  shift  divisor  dovn  8  }. 
yes;  shift  4. 


can  the  remainder  be  shifted  up  again  ? 
no;  (  shift  the  divisor  dovn  4  ). 
yes;  shift  4  a  second  time. 


divide  the  remainder  by 


DIVISOR. 


(quot.)  ->  D 


rem.  ->  X  (store  rem.) 


shift  divisor  dovn  8, 


LSRD 

LSRD 

ADDD 

«1 

and  round  up. 

STD 

DIVISOR 

IGDX 

(quot.)  ->  X  rem.  ->  D 

JSR 

B.ROLLS 

divide  the  remainder  by  DIVISOR. 

BRA 

LIIE8 

LIIE7 

XGDI 

(quot.)  ->  D  rem.  ->  X  (store  rem.) 

LDD 

DIVISOR 

LSRD 

LSRD 

shift  divisor  dosn  4, 

LSRD 

LSRD 

ADDD 

and  round  up. 

STD 

DIVISOR 

IGDX 

(quot.)  ->  X  rem.  ->  D 

JSR 

B.ROLLS 

divide  the  remainder  by  DIVISOR. 

«*«»«**««***«««*******««**iiiiii««**««4i*******4i**************e»******* 

LIIE8 

X6DX 

quot.  ->  D  (rem.)  ->  X 

STAB 

V.ACC+1 

store  8  l.B.  bits  of  the  quotient 

into  V.ACC+l.  lote  that  the  8  m.s. 

» 

TST 

SIGI 

bits  sill  always  be  0  in  this  case 
should  the  final  result  be  negative  ? 

BPL 

LIIE9 

LDD 

V.ACC 

COHA 

COHB 

ADDD 

«1 

STD 

V_ACC 

yes;  negate  V.ACC,  V.ACC+l. 

LIIE9 

CLR 

V_ACC+2 

always  clear  V.ACC+2. 

RTS 

««*«««««*«*«*««******ik«*****i|[**4i4>«4ii|i***4>*****«««it********4>****4t** 

*  th«  barrel  roll  subroutine  assuBes  that  the  diTidend  is  in 

*  the  D  accunulator  and  divisor  is  in  DIVISOR.  It  returns  the 

*  quotient  in  the  X  register  and  the  remainder  in  the  D  register. 

*  See  Coiiq>uter  Organization  (McGrae  Hill)  p.  267  for  details  on 

*  the  non-restoring  integer  division  algorithm. 
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B.ROLLS  X6DX 

dividend  ->  X  (Q) 

LDAA 

»16 

STU 

coinrr 

initialize  count  to  16  (  =  #  of  bits) 

CLRA 

UNCLASSIFIED  A-5 


CLRB 

clear  D  regiater. 

(A) 

LOOP 

TSTA 

is  "A"  positive  ? 

BNI 

LIIEI 

IGDl 

yes;  A  ->  I 

q  -> 

D 

ASLD 

shift  q 

IGDI 

A  ->  D 

q  -> 

I 

ROLB 

ROLA 

shift  A 

SUBD 

DIVISOR 

subtract 

M 

BRA 

LIIE2 

LIIEI 

ZGDX 

no;  A  ->  X 

q  -> 

D 

ASLD 

shift  Q 

XGDX 

A  ->  D 

q  -> 

X 

ROLB 

ROLA 

shift  A 

ADDD 

DIVISOR 

add  M 

LIIE2 

TSTA 

is  A  positive  ? 

BMI 

LIIE3 

yes; 

XGDX 

ORAB 

«01H 

set  Qo  to  1. 

XGDX 

BRA 

LIIE4 

LIIE3 

XGDX 

no; 

AIDB 

«OFEH 

set  Qo  to  0. 

XGDX 

LIIE4 

DEC 

COURT 

decreaent  count. 

BIE 

LOOP 

loop  back. 

RTS 

« 

*  iRCTil 

* 

*  ARCTAI  IS  A  REVERSE  LOOK-UP  OF  TAI.TBL. 

«  IT  RETURIS  AI  AI6LE  BETHEEI  -PI/2  AID 

*  +PI/2.  EXPRESSED  II  RADS/8.  THE  ARGDMEIT 

*  OF  THIS  MACRO  IS  UIDERSTOOD  AS  HAVIIG  AI 

*  EIPOIEIT  OF  2*8. 
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ATI  LDD  V.ACC 
STD  TAI 


UNCLASSIFIED 


BNI 

TI.q4 

BSR 

ATAI 

RTS 

TI_04 

COMA 

COMB 

ADDD 

«1 

STD 

TAR 

BSR 

ATAR 

LDD 

V.ACC 

COMA 

COMB 

ADDD 

#1 

STD 

V_ACC 

RTS 
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iTAI 

LDX 

RTAR.TBL 

STI 

TR.LASTX 

CLR 

RESULT 

LDAB 

«80H 

ATill 

STAB 

DELTA 

ABX 

ABX 

LDAA 

TAR 

CMPA 

o.x 

BLO 

ATAR3 

BHI 

ATAR2 

PSHA 

LDAA 

TAR+1 

CMPA 

l.I 

PULA 

BLO 

ATAR3 

iTiI2 

STX 

TI.LASTX 

ADDB 

RESULT 

STAB 

RESULT 

BRA 

ATAR4 

iTiia 

LDX 

TR.LASTX 

ATiI4 

LDAB 

DELTA 

LSRB 

BEQ 

DORE.ATR 

BRA 

ATARI 

DOIE.ATl 

LDAA 

RESULT 

CLRB 
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